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Abstract: We present a simple and natural extension of the m,ulti-rohot 
motion planning problem where the robots are partitioned into groups (col- 
ors), such that in each group the robots are interchangeable. Every robot is 
no longer required to move to a specific target, but rather to some target 
placement that is assigned to its group. We call this problem k-color multi- 
robot motion planning and provide a sampling-based algorithm specifically 
designed for solving it. At the heart of the algorithm is a novel tcchniqiie 
where the fc-color problem is reduced to several discrete multi-robot mo- 
tion planning problems. These reductions amplify basic samples into massive 
collections of free placements and paths for the robots. We demonstrate the 
performance of the algorithm by an implementation for the case of disc robots 
in the plane and show that it successfully and efficiently copes with a vari- 
ety of challenging scenarios, involving many robots, while a straightforward 
extension of prevalent sampling-based algorithms for the /c-color case, fails 
even on simple scenarios. Interestingly, our algorithm outperforms a state-of- 
the-art implementation for the standard multi-robot problem, in which each 
robot has a distinct color. 



1 Introduction 

Motion planning is a fundamental problem in robotics and has applications 
in different fields such as the study of protein folding, computer graph- 
ics, computer-aided design and manufacturing (CAD/CAM) and computer 
games. 
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The problem of motion planning, in its most basic form, is to find a 
collision-free path for a robot from start to goal placements while moving 
in an environment cluttered with obstacles. 

An obvious extension of this problem is multi-robot motion planning, where 
several robots share a workspace and have to avoid collision with obstacles 
as well as with fellow robots. In many situations it is natural to assume 
that some robots are identical, in form and in functionality, and therefore 
are indistinguishable. In this setting every target position should be occu- 
pied by some robot of a kind (and not necessarily by a specific robot). 

We consider the problem of k-color multi- 
robot motion planning — a simple and nat- 
ural extension of the multi-robot problem 
where the robots are partitioned into k 
groups (colors) such that within each group 
the robots are interchangeable. Every such 
group has a set of target positions, of size 
equal to the number of robots in that group. 
Every robot is no longer required to move 
to a specific target, but rather to some tar- 
get position that is assigned to its group. 
However, we still require that all the target 
positions will be covered by the end of the 
motion of the robots. We term the special 
case where k = 1 the unlabeled multi-robot 
motion planning problem. 

As an example consider a fleet of mobile 
robots operating in a factory that are given 
the task of cleaning a set of specific loca- 
tions. The robots are indistinguishable from 
one another, and therefore any robot can be 
assigned to any location. Now assume that 
in addition to the mobile robots, another 
class of maintenance robots is employed by 
the factory; again, we consider all the main- 
tenance robots to be of the same kind and 
interchangeable for the given task. This turns the unlabeled problem into a 
fc-color problem, where fc = 2 in this case. 

From now on we will refer to the classic multi-robot motion planning 
problem as fully-colored, as it is a special case of the fc-color problem where 
k is equal to the number of robots and every group is of size one. 

1.1 Previous Work 

Throughout this work we will assume some familiarity with the basic terms 
in the area of motion planning. For more information on motion planning, 
see, e.g., [7, 15]. 




Fig. 1: An example of a 3- 
color scenario where three dif- 
ferent groups of robots occupy 
the same workspace. The star- 
shaped (orange) robots are re- 
quired to exchange "rooms" 
with the snake (red) robots 
while the two puzzle-like (pur- 
ple) robots should return to 
their start positions in the end 
of the motion. Obstacles are 
drawn in gray. 
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The first efforts in motion planning in general, and the multi-robot case 
in particular, were aimed towards the design of com,plete algorithms, guaran- 
teed to find a solution when one exist or report that none exists otherwise. 
Schwartz and Sharir were the first to give [21] a complete algorithm for a 
multi-robot problem, specifically dealing with the case of coordinating disc 
robots in the plane. The running time of this algorithm is exponential in the 
number of robots. A work by Hopcroft et al. [10] presented soon after sug- 
gested that in some cases the exponential running time may be unavoidable, 
showing that even the relatively simple setting of rectangular robots bound 
in a rectangular region is PSPACE-hard in the number of robots. 

The hardness of the multi-robot problem involving a large number of 
robots can be attributed to its high number of degrees of freedom (or dofs) — 
the sum of the dofs of the individual robots. Some efforts were made in the 
direction of reducing the effective number of dofs. Aronov et al. [2] showed 
that for the case of systems of two or three robots a path can be constructed, 
if one exists, where the robots are moved while maintaining contact, thus 
reducing the number of dofs by one or two, depending on the number of 
robots, van den Berg et al. [5] proposed a general scheme for decomposing 
a multi-robot problem into a sequence of subproblems, each composed of a 
subset of robots, where every subproblem can be solved separately and the 
results can be combined into a solution for the original problem. This method 
reduces the number of dofs of the entire problem to the number of dofs of 
the largest subproblem. 

An opposite approach to the complete planners is the decoupled approach, 
trading completeness with efficiency. Decoupled algorithms solve separate 
subproblems (usually for individual robots) and combine the individual solu- 
tions into a global solution. Although this approach can be efficient in some 
cases, it does not guarantee finding a solution if one exists and usually works 
only for a restricted set of problems. An example of such an algorithm can be 
found in the work of van den Berg and Overmars in [4] where every robot is 
given a priority and for each robot, the motion path is constructed to avoid 
collision with both static obstacles and lower-priority robots that are con- 
sidered as moving obstacles. In other works, as in [16], individual paths are 
computed and velocity tuning is performed to avoid collision between robots. 

In recent years the samplmg-based approach for motion-planning prob- 
lems has become increasingly popular due to its efficiency, simplicity and the 
fact that it is applicable to a wide range of problems. Unlike the complete 
planners that explicitly build the configuration space ( C-space ) of a given 
problem, the state of all possible configurations of a robot, sampling-based 
algorithms construct an implicit representation of a robot C-space by sam- 
pling this space for valid robot placements and connecting nearby samples. 
The connections between samples form a roadmap whose vertices describe 
valid placements for the robot and the edges represent valid paths from one 
placement to the other. Due to the implicit representation of the C-space 
and their simplicity, sampling-based algorithms tend to be much faster than 
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complete planners in practice, and are applicable to problems with a large 
number of dofs such as the multi-robot problem. Although these algorithms 
are not complete, most of them are probabilistically complete, that is, they are 
guaranteed to find a solution, if one exists, given sufficient amount of time. 
Examples of such algorithms are the PRM algorithm [11] by Kavraki et al. 
and the RRT algorithm [14] by Kuffner and LaValle. Such algorithms can 
be easily extended to the multi-robot case by considering the fleet of robots 
as one large composite robot. Several tailor made sampling-based algorithms 
have been proposed for the multi- robot case [9, 24]. For more information on 
sampling-based algorithms see, e.g., [15]. 

An abstract form of the multi-robot motion planning problem is the pebble 
motion on graphs problem [13]. This is a general case of the famous 15- 
puzzle [17] where pebbles occupying distinct vertices of a given graph are 
moved from one placement of vertices to another, where a move consists of 
transferring a pebble to an adjacent unoccupied vertex. In some variants it is 
assumed that the graph is a tree [3] , while in others there is a single pebble 
and several movable obstacle-pebbles on the nodes of the graph [19]. In [6] 
an unlabeled version of the pebble problem is discussed, as well as other 
variants, such as a grid topology. We also mention the recent work [18] where 
an algorithm is given for the general pebble problem. 

1.2 Contribution 

In this paper we present a sampling-based algorithm for the fc-color problem 
(for any k). This algorithm is aimed to solve the most general cases of this 
problem and does not make any assumptions regarding the workspace or the 
structure of the robots. 

Our algorithm for the /c-color problem — the KPUMP algorithm — reduces 
the fc-color problem to several discrete pebble problems. Specifically, a sample 
generated by KPUMP represents a local fc-color problem that is embedded 
in a variant of the pebble motion problem. Those pebble problems are con- 
structed in a manner that enables the algorithm to transform movements 
of pebbles into valid motions of the robots. This allows KPUMP to gener- 
ate a wide range of motions and placements for the robots with minimal 
investigation of the configuration space, thus reducing the dependence of the 
algorithm on costly geometric tools such as the collision detector. 

As reflected by the experiments reported below for the case of disc robots 
in the plane, KPUMP proves to be efficient, even on challenging scenes, and 
is able to solve problems involving a large number of robots using a mod- 
est number of samples. Interestingly it performs well even on inputs of the 
standard (fully-colored) multi-robot problem. 

This algorithm is simple to implement and does not require special geomet- 
ric components beyond single-robot local planners and single-robot collision 
detectors. We compare the performance of our algorithm with a variant of 
the PRM algorithm for the same problem that uses those components and 
show that the latter performs much slower than KPUMP and fails to solve 
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even problems that are considered to be simple for KPUMP. This implies 
that using the same components KPUMP provides a much more powerful 
alternative. Moreover, concentrating on the fully-colored case, KPUMP out- 
performs a state-of-the-art implementation of the PRM algorithm. 

The organization of the paper is as follows. In Section 2 we give formal 
definitions of the unlabeled and A;-color problems. In Section 3 we present a 
variant of the pebble problem and its properties which will be used in our 
algorithms. In Section 4 we present UPUMP an algorithm for the unlabeled 
case — and describe the changes necessary to extend it to KPUMP. We present 
experimental results for the case of disc robots moving among polygonal 
obstacles in the plane in Section 5 and discuss the properties of KPUMP 
in Section 6. For lack of space we omit a full description of KPUMP and a 
subroutine used by UPUMP, as well as some other less crucial details. They 
are provided in the supplementary material [23]. 

2 Preliminciries and Definitions 

Let be a workspace and r a robot in this workspace. We denote the free 
space of a robot r — the collection of all collision-free single-robot configurations — 
by J^{r). Given s,t € J^{r) a path for r from s to f is a continuous function 
TT : [0, 1] F{r) such that 7r(0) = s, 7r(l) = t. 

Unlabeled Multi- Robot Motion Planning. We say that two robots r. r' 
are geometrically identical if F{r) = J^{r'). Let R = {ri, . . . ,rm} be a set of 
m geometrically identical robots, operating in a workspace W. As the robots 
are geometrically identical we use to denote T{ri) for any 1 < i < m. 
Let C = {ci, . . . , Cm\ci G J-"} be a set of m single-robot configurations. C is a 
configuration if for every c,c' £ C,c ^ c' the robots r,r' G R placed in c, c' do 
not collide. Notice that we reserve the imqualified term configuration to refer 
to a set of m collision-free single-robot configurations. Other types of config- 
urations will be qualified single-robot configurations, pumped configurations, 
etc. 

Given two configurations S = {si, . . . , s^}, T = {ti, . . . , tm} named start 
and target configurations, respectively, we define U = {R, S, T) as the unla- 
beled problem, which is shorthand for the unlabeled multi-robot motion plan- 
ning problem. Our goal is to find an unlabeled path ttu, defined as follows. 
Firstly, ttu is a collection of m paths {tti, . . . , TTm} such that for every i, tTj 
is a collision-free path for the robot from Sj to some t G T. Secondly, the 
robots have to remain collision-free while moving on the respective paths, 
i.e., for every 6 G [0, 1] 7Tu{9) = {711(6*), . . . , 7rm(0)} is a configuration. Notice 
that this also implies that 7ri/(l) is some permutation of T. 

fc-Color Multi- Robot Motion Planning. Let Ui, . . . ,Uk be k unlabeled 
problems where = {R^, Si,Ti). C = {Ci, . . . ,Ch} is a composite configu- 
ration if for every 1 < i < A; Cj is a configuration for Ui and for any pair of 
robots r G Ri,r' G Rj placed in some cGCi,d G Cj do not collide. 
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The /c-color problem L is defined by the set {ZYi, . . . and our goal is 
to find a k-color path = {t^Ui j • • • i '"'Wfc} where t^u^ is the unlabeled path of 
Ui. In addition, we require that i^ciS) will be a composite configuration for 
every 9 € [0, 1] (this ensures that robots will not collide with one another). 

A special case of this problem, usually named simply multiple robots mo- 
tion planning, is a fc-color problem where every Ui is comprised of a single 
robot, namely |-Ri|= 1. In our context we call this special case fully- colored. 

3 The Pebble Motion Problem 

In preparation for the algorithms presented in the next two sections we dis- 
cuss a variant of the problem of pebble motion on graphs. This problem is 
a discretization of the unlabeled problem. Our variant is defined in a way 
that will allow us to transform local unlabeled problems into pebble prob- 
lems such that a movement of the pebbles can be transformed back into valid 
robot motions. 

Formal Definition. A pebble problem [13] 7^(0) is defined by an undirected 
graph G = {V,E), where \V\= n. A pebble placement is an ordered set of 
distinct vertices of V. Given two pebble placements S, T such that |5|= |r| = 
TO for some to the pebbles t\,. . . ,Tm are placed on the nodes S. We wish 
to find a chain of placements (of size to) tt* = Pi, . . . ,Pe called a pebble 
path, which obeys the following set of rules. Firstly, we demand that Pi = 
S. Secondly, for every two consecutive placements P = {pi, . . . ,Pm}, P' = 
{p'l, . . . ,p'^} and every i € [m] it holds that {Pi,Pi) £ E or pi = p'^, i.e., the 
pebble is allowed to stay in its current vertex or move to a neighboring 
vertex in the graph. 

Next we depart from the problem definition in [13]. We demand that Pf, is 
some permutation of the elements of T. (The original formulation [13] speci- 
fied which pebble will reside on which specific vertex of T.) We do, however, 
impose an additional requirement — the separation rule — which requires that 
the pebbles will move separately, i.e., for every two consecutive placements 
P, P' , as defined above, exactly one pebble Tj makes a move on an edge, while 
the other pebbles remain stationary. More formally, there exists i £ [m] such 
that {pi,Pi) G E and for every j ^ i it holds that pj = p'j. The necessity of 
this restriction will become clear later on. 

Solvability. The variant of the pebble problem used in this paper possesses 
the following property, which will come in handy in the following sections. 
Denote the number of connected components of G by £ and let {Gi, . . . , Ge} 
be the set of maximal connected subgraphs of G, where Gj = {Vi, Ei). Given 
a placement V for the pebble problem V{G) we define the signature of V 
assig(G,F') = {|rnF,|}ti. 

Lemma 1. For every pebble problem P{G) and every two placements S,T 
such that sig(G, S) = sig(G, T) there exists a pebble path from S to T. 
This property is proved in [6] where they refer to the problem defined above 
as moving chips in a graph. Even though an algorithm is provided as well we 
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decided to use a simpler algorithm which constructs spanning trees on the 
connected components and balances the pebbles within the trees. This algo- 
rithm is omitted here for lack of space; it can be found in the supplementary 
material [23]. 

4 Algorithm for the Unlabeled Case: Configuration 
Clusters 

In this section we present our main contribution — a sampling-based algo- 
rithm for the imlabclcd problem. The algorithm, UPUMP, samples sets of 
single-robot configurations of size larger than the actual number of robots, 
to seemingly accommodate an increased number of robots. We call these 
sets pumped configurations. Each sampled pumped configuration rcsiilts in a 
structure we call configuration cluster (or simply cluster), which implicitly 
represent a collection of configurations and the connections between them. 
These connections are the result of an underlying pebble motion problem, 
defined on the elements of the pumped configuration, where movements of 
pebbles from one pebble placement to the other are mapped into motions of 
robots between configurations within the cluster. 

This technique makes use of the fact that our problem does not involve 
one complex robot, but rather a collection of robots operating in the same 
configuration space. This is in stark contrast with a popular sampling-based 
technique that considers the group of robots as one composite robot. In our 
opinion, the latter suffers from an acute disadvantage compared to our tech- 
nique. We will demonstrate this claim experimentally and discuss the benefits 
of UPUMP and KPUMP in depth later on. 

After discussing the construction of clusters and exploring their various 
properties we show that clusters can be connected to generate paths for 
the robots not only moving from configuration to configuration within the 
same cluster but also between configurations belonging to different clusters. 
We conclude this section with a description of the full configuration-clusters 
sampling-based algorithm and state the changes required to extend UPUMP 
to KPUMP. 

4'1 Construction of a Configuration Cluster 

We define more formally some of the structures mentioned earlier. 
Definition 1. [Pumped Configuration] Let V = {vi, . . . ,Vm>} for m! > m 
be a set of single-robot configurations such that for every v \i holds that 
V € where F = F{r) for some r & R.V \s& pumped configuration if every 
C CV, such that |C|= m, is a configuration. 

Given a pumped configuration V we construct a graph G = {V, E) whose 
vertices are the elements of V , and the edges represent paths in J- for indi- 
vidual robots. We call this type of graph geometric. To generate the edges of 
G, and the respective paths, we utilize the following mechanism. 
Definition 2. [Edge Planner] Given Vi,Vj G V such that F is a pumped 
configuration and Vi ^ Vj the edge planner generates a path 7r„^,^^. or reports 
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failure, tt^.^^,^. is a path for r G i? from Vi to Vj, such that for every k ^ i,j 
the robot r, while moving on this path, does not collide with a (geometrically 
identical) robot placed in Vk- 

The edge planner is applied on every pair Vi ^ Vj in V. Upon a successful 
generation of a path tt^.^^^. the edge {vi, Vj) is added to G. An example of a 
pumped configuration, as well as its underlying graph, is given in Figure 2. 

Given such graph G for the pumped configuration V we define the cluster 
of G as Cg = {C\C C V, \C\= m}. Namely, Cq is the collection of all con- 
figurations in the pumped configuration V. However, we do not require that 
all these configuration will be explicitly constructed within each cluster, and 
as we will see later on, an explicit representation of only some of the con- 
figurations will be required eventually. The following proposition discusses 
the existence of paths between configurations within the same cluster, (see 
Section 3 for the definition of sig(G, V)). 

Proposition 1. Let C, C G Cg and sig(G, G) = sig(G, G'). Then there exists 
apathnw forW = (G, G'). 

Proof. By Lemma 1 there exists a pebble path tt* for 7'(G) from start to 
target pebble placements V and V , respectively. For a given pebble path tt* 
we convert every movement of a pebble into a movement of the respective 
robot. Given a pebble Tj that moves on the edge (u, v) of G, from u to w we 
add an unlabeled path section where the robot rj moves from u €V to v 
along ■nu,v, generated by the edge planner, while the rest of the robots in R 
stay put throughout this motion. As tt* obeys the separation rule only one 
robot can move at any given time. Moreover, moving robots cannot collide 
with obstacles or stationary robots as they are moving on paths generated 
by the edge planner. An example for such a path is given in Figure 2(b). □ 

4-2 Connecting Configuration Clusters 

Proposition 1 implies that certain unlabeled problems can be solved using a 
single cluster. However, this statement does not hold for many other instances 




(a) (b) 

Fig. 2: (a) Pumped configuration V with m = 3,m' = 6 for the problem of disc robots in 
the plane. C,C' are two configurations such that C,C' C V. (b) The geometric graph G 
induced by V using an edge planner that tries to connect two configurations with a straight- 
Une path. In addition a path, induced by a pebble path, from C to C" is described, where 
the orange arrows describe the movements of the robots from one single-robot configuration 
to its neighbor and the numbers indicate the order in which those movements occur. 
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of the unlabeled problem. As an example consider U = {S,T) in which there 
exists at least one pair s G S,t G T, s ^ t such that a robot r € R placed in s 
overlaps with another robot r' G R placed in t. Thus, s,t cannot be in the 
same pumped configuration. 

Fortunately, wc can combine several clusters in order to find paths for more 
general unlabeled problems. We first show that two clusters can be combined 
to generate paths for the robots moving from one cluster to the other. 

Lemma 2. Given a pair of clusters Cg,Cg' let C,C' be two configurations 

such that C € Cq, C € Cq' and let ttc.C be a path for the unlabeled problem 
U' = {C\C'). In addition, let D,D' be two configurations such that D S 
Cg,D' e Cg' and sig(G,£») = sig(G,C) and sig(G',£>') = sig(G',C"). Then 
there exists a path wu" forU" = {D,D'). 

Proof. By Proposition 1 there is a path -kud foi" = {D,C) and, simi- 
larly, a path TTu^, for Ud' = {C',D'). Thus, the concatenation of the paths 
ttWd : 7^0,0' , t^Ud' yidds a path for W. □ 
Paths connecting configurations from different clusters are generated using 
the following component which generalizes the component local planner used 
in standard sampling-based algorithms. 

Definition 3. [Connection Generator] Let Cg,Cg' be two clusters. The con- 
nection generator returns a collection of paths such that every path 'jtg,c' 
in the collection is a solution for the unlabeled problem U' = (C, C) where 

CeCcC'eCc'. 

In the implementation of the connection generator a collection of single- 
robot paths between single-robot configurations from the two clusters are 
generated. The interactions between these paths are modeled in a graph. 
Specifically, every vertex of the graph represents a single-robot path and two 
vertices are connected by an edge if robots moving on the respective paths 
collide. Consequently, an independent set of vertices in this graph represent 
a set of non-colliding paths. A full description of the connection generator is 
provided in [23]. 

4.3 Description of VPVMP 

Next, wc extend the result of Lemma 2 to generate still more complex paths. 
Algorithm UPUMP samples clusters (by generating random pumped config- 
urations), then it generates paths connecting configurations form different 
clusters. Those paths will represent edges in a roadmap T-L whose vertices are 
configurations. Additional edges, that represent paths between configurations 
within the same cluster with identical signatures are added to H afterwards. 
We mention that even though the roadmap T-l does not contain clusters, every 
configuration in H is associated with a specific cluster. Throughout the text 
below we will employ the following notation. Let Cg be a cluster and let C 
be a configuration such that C gCq- To refer to the cluster of C we use the 
notation C(C), i.e., C(C) = Cq. 
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Sampling: UPUMP samples a collection of pumped configurations and 
generates the respective respective geometric graphs and clusters. 

Connecting configurations in different clusters: The connection generator 
is applied on every pair of clusters Cg,Cg'- For every returned path Trc,C' 
UPUMP adds C, C as vertices to T-L. In addition it adds an edge between 
those two vertices with the attached information ttc,C'- As S and T can be 
viewed as clusters, containing a single configuration, we try to connect them 
to different clusters using the connection generator as well. 

Connecting configurations within the same cluster: By Proposition 1 for 
every two nodes C,C" of U, such that C(C) = C(C") and sig(C(C),C) = 
sig(C(C"), C"), there exists a path for U' = [C.C). Therefore, we may add 
an edge in "H between C,C'. We do not generate the respective paths at 
this point as only some of them will eventually participate in the final path 
connecting S to T. 

The following corollary allows us to transform vertex paths in H into a 
path for the unlabeled problem U. It is a direct result of Lemma 2. 

Corollary 1. Suppose that V. contains a vertex path Cq,...,C(, such that 
Co = S* , Ce = T* , for every 1 < i < £ it holds that (Ci_i,C,) is an edge in 
H . Then there exists an unlabeled path for U . 

As the paths between different clusters have already been constructed by the 
connection generator, we are only required to generate paths induced by peb- 
ble motions between Cj_i, Cj such that C{Ci-\) = C{Ci),sig{C{Ci-\), Ci-\) = 
sig(C(C,),CO. 

4.4 Extension to KPUMP 

We briefly describe some of the changes necessary to transform UPUMP 
to KPUMP — an algorithm for the fc-color problem. Although it may seem 
natural to allow robots from different unlabeled problems to share common 
geometric graphs we chose to take a diff'erent approach. KPUMP simultane- 
ously samples several pumped configuration — each corresponds to a distinct 
color (namely, a different unlabeled problem) . The resulting geometric graphs 
are constructed in a manner which prevents collision between robots from 
different unlabeled problems. This calls for a redefinition of the edge plan- 
ner as well as other components. Similarly to UPUMP, KPUMP construct 
a roadmap, with the exception that its vertices are no longer configurations 
but composite configurations (see Section 2). The full description of KPUMP 
is provided in [23]. 

5 Experimental Results 

We describe experimental results for the case of disc robots in the plane mov- 
ing amidst polygonal obstacles. We show results for five challenging scenarios 
and compare the performance of KPUMP with two other sampling-based al- 
gorithms. Specifically we compare KPUMP with the PRM implementation of 
the OOPSMP package [20] on inputs of the fully-colored problem. For other 
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inputs we use a basic sampling-based algorithm for the /c-color problem called 
KBASIC, described later on. 

KPUMP was implemented in C++ using CGAL Arrangements [8] and 
the Boost Graph Library (BGL) [22]. The code was tested on a PC with 
Intel 17-2600 3.40GHz processor with 8GB of memory, running a Windows 
7 64-bit OS. For the implementation of the edge generator and single-robot 
local planner (used by the connection generator) a straight-line connection 
strategy [1] was used. This strategy attempts to move the robot along a 
straight line drawn between the start and target positions. 

Parameters of KPUMP. The algorithm has three parameters that affect 
its performance: n describes the number of sampled clusters; c is the number 
of paths that the connection generator attempts to produce between every 
two clusters; fj, is the maximal number of single-robot configurations that one 
sample comprises. For instance, in the case of an unlabeled problem the size 
of every sampled pumped configuration will be at most ^. The value of the 
latter parameter depends on the input problem. For unlabeled problems in- 
creasing /i results in increased connectivity of the resulting geometric graphs. 
Thus, it will be beneficial that the pumped configurations will be as large 
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Fig. 3: [Best viewed in color] Start positions of the robots are indicated by discs while 
target positions are illustrated as circles in respective colors (unless otherwise indicated) 
(a) Unlabeled scene with twenty five robots, (b) 2-Color scene; the two groups are required 
to switch positions, (c) Fully-colored scene with eight robots, (d) Fully-colored scene with 
five robots, (e) 4-Color scene; every group has to move in a clockwise manner to the next 
room, e.g., blue group should move to the bottom room. 
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as possible (limited by the topology of the scenario). On the other hand, in 
fc-colored problems where fc > 1 the value fi has to be set more carefully as 
an excessively high value of fj, will reduce the connectivity of the geometric 
graphs. This stems from the fact that the a single-robot path produced by 
the edge planner has to avoid collision with robots from other groups. Con- 
sequently, as the value of /z grows it becomes harder to connect single-robot 
configurations using an edge planner. 

Test Scenarios. The scenarios are illustrated in Figure 3 and represent a 

variety of challenging problems. The unlabeled problem in (a) involves the 
motion of a large collection of robots. Scenarios (b) and (e) describe 2-color 
and 4-color problems comprising a large number of robots as well. Although 
scenarios (c),(d) do not involve as many robots, they are nevertheless ex- 
tremely challenging. This range of problems demonstrate the work of the 
various components of the KPUMP algorithm. In the first three scenarios 
the resulting geometric graphs have a low number of connected components 
due to the low value of k (as in scenario (a)) or high clearance from ob- 
stacles (as in (e)). Therefore, large portions of the resulting paths involve 
the motions of the robots on paths induced by pebble problems. While the 
generated graphs in scenarios (c) and (d) have low connectivity, KPUMP 
still performs well — due to the use of the connection-generator component. 

The results of running KPUMP 

r -n , • • Table 1: Results for selected scenarios, 

tor specinc parameters are given m 

Table 1. In addition to the parame- 
ters mentioned above, the table con- 
tains the values k for the number of 
colors, nii the number of robots in 
every group and M the total num- 
ber of robots. The running times 
are given in seconds. The parame- 
ters used by KPUMP, as well as the 

parameters of other algorithms mentioned later on, were manually optimized 
over a concrete set. 

Comparison with Other Algorithms. The first part of the comparison 
involves solely inputs of the fully-colored problem. We compare KPUMP with 
the implementation of PRM provided by OOPSMP. which, by our experience, 
is very efficient. This algorithm is designed for solving single-robot and fully- 
colored multi-robot motion planning problems. While OOPSMP required 100 
seconds to solve scenario (d), KPUMP managed to solve it in 1.9 seconds. 
Scenario (c) proved to be even more challenging for OOPSMP, which failed 
to solve it, even when was given 5000 seconds of preprocessing time, whereas 
KPUMP solved in 213.7 seconds. 

In order to provide a more informative comparison we ran both algorithms 
on scenarios (c),(d), only that now we increased the difficulty of these sce- 
narios gradually — incrementally introducing the robots to the scenarios, i.e.. 
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25 
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32 
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100 


25 


1.9 
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3 


12 


40 


250 


28 


32.9 
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starting with a single robot and adding the others one by one, as long as 
OOPSMP succeeded solving the new inputs in reasonable time. In this case 
OOPSMP was able to solve scenario (c) with five robots, while six robots 
was out of its reach (when given 5000 seconds of preprocessing time). The 
speedup of KPUMP compared to OOPSMP for this new range of scenarios is 
depicted in Figure 4 along with an additional test case ("decoupled-simple"), 
which is a simpler variant of scenario (c) with some of the obstacles removed 
and the radius of the robots is decreased. The latter was designed to test the 
performance of OOPSMP on problems involving a higher number of robots. 

As we are not aware of any other algorithms for the /c-color problem (A; > 1) 
we designed a basic algorithm to compare KPUMP with. This algorithm, 
which we call KB ASIC, is an extension of the PRM algorithm for the k- 
color case. It can be described as a special case of KPUMP that samples 
configurations, instead of pumped configurations. 

The entire set of scenarios (a)-(e)(in their original form) proved to be 
too challenging for KBASIC that spent at times more than tens of minutes. 
Similarly to the previous comparison we designed a set of simple test sce- 
narios. Specifically, scenario (e) was converted into five /c-color problems for 
1 < fc < 5 by partitioning the robots into k groups such that a robot number 
i was assigned to the group i mod fc. Then, as in the previous comparison 
the robots were introduced incrementally to the five scenarios. Figure 4 de- 
picts the speedup of KPUMP compared with KBASIC for each of the fc-color 
problems. This shows that KPUMP outperforms KBASIC in every possible 
setting, be it fc-color, unlabeled or fully-colored problem. 

6 Discussion 

In this section we discuss the various properties of the KPUMP algorithm 
and novelties it encompasses. 

Expanding the Sampling-Based Scheme. Typically, sampling-based al- 
gorithm, such as PRM and RRT, decompose the input problem into subprob- 
lems that are assumed to be easier than the original problem. Specifically, 
the task of path finding between two remote configurations is transformed 
into several (often many) problems where nearby pairs of configurations are 
connected. Consider a more general view of this approach where one is given 
a powerful "black-box" component that is able to solve specific instances of 
the motion-planning problem. To harness the power of this component one 



KPUMP vs. OOPSMP KPUMP VS. KBASIC 




Number of Robot.s Number of Robots 



Fig. 4: [Best viewed in color] Comparing KPUMP with OOPSMP/PRM and KBASIC 



14 



Kiril Solovey and Dan Halperin 



would decompose the input problem into subproblems that can be solved 
with the component and combine the sohitions to the subproblcm into a so- 
lution to the input problem. As a deterministic decomposition is not always 
possible, one would try to sample subproblems with the hope that some of 
them contain information that is crucial for solving the full problem. 

KPUMP is an example of such an algorithm. Specifically, KPUMP de- 
composes the fc-color problem into local fc-color problems — instances that 
can transformed into pebble problems. Subproblcm sampling is achieved by 
sampling configuration clusters while the connections of the subproblems is 
achieved with the connection generator component. The pebble problem al- 
lows us to transform problems in the continuous configuration space into a 
discrete problem on graphs. While a transformation to a discrete represen- 
tation occurs also in other sampling-based algorithm it is only used for the 
purpose of modeling paths that were generated in the configuration space. 
In our case, however, the pebble problem produces new paths that were not 
previously generated in the configuration space. The variant of the pebble 
motion on graphs used in this paper allows us to efficiently generate such 
paths and considerably reduces the use of heavy-duty geometric operations 
such as collision detection. 

Shortcomings of the Composite Robot Approach. The traditional 

composite robot approach to the multi-robot problem treats the group of 
robots as one composite robot whose configuration space is the Cartesian 
product of the configuration spaces of the individual robots. With this ap- 
proach single-robot tools, such as sampling-based algorithms, can be used to 
solve multi-robot problems. For instance, this technique is used in the soft- 
ware packages OOPSMP and OMPL [12, 20] where PRM is appfied to the 
fully-colored problem, and in the KBASIC algorithm discussed above. Paths 
generated by this approach usually force the robots to move simultaneously 
from one placement to the other, where none of the robots remains in the 
same position while the others are moving. 

We believe that such paths are unnatural in the multi-robot setting and are 
more diflacult to produce than paths that involve motion of only few robots 
at a time. Given collision-free placements for all the robots it is usually pos- 
sible to move some of the robots to different placements without altering 
the placements of the rest of the robots, i.e., those robots remain still. For 
instance, consider a configuration C = {ci, . . . , Cm} for some unlabeled prob- 
lem U. Unless the workspace is extremely tight, another configuration C 
can be derived from C where ci is changed to c/^. Moreover, connecting two 
such configurations by a path requires only a single-robot collision-free path 
for which the moving robot does not collide with the other robots placed in 
C2, - ■ ■ ,Cm- In contrast, the connection of two "unrelated" configurations by 
a path imposes miich harder constraints — m single-robot collision-free paths 
have to be created and in addition robots moving along those paths must not 
collide with each other. 
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KPUMP utilizes this observation by restricting the movements of the 
robots along certain path sections — induced by pebble problems — to motions 
of individual robots. We mention that KPUMP does not preclude simultane- 
ous movements of robots when necessary, specifically on path sections where 
the robots move from one cluster to the other along paths generated by the 
connection generator. 

Amplification of Samples. The pumped configurations sampled by KPUMP, 
and the resulting geometric graphs are fairly simple structures that require 

only little effort to generate. Yet, using pebble problems, such samples can be 
amplified to describe not only placements and paths for single robots, but also 
to represent an incredible amount of paths and positions all the robots in a 
given problem. Configuration clusters that result from such pumped configu- 
rations, represent a collection of ni=i (mO configurations and a large number 
of connections between them. However, this information is not explicitly rep- 
resented and only little storage space is required to represent a single cluster. 
In particular, one is only required to store the pumped configurations and the 
geometric graphs that define the cluster as well as a modest number of indi- 
vidual configurations from this cluster. Specifically, those are configurations 
through which the cluster connects to other clusters. Such configurations are 
selected by the connection generator. Similarly, this component does not re- 
quire an explicit representation of the clusters and can deduce the structure 
of the cluster from the pumped configurations that define it. Furthermore, 
continuing the theme presented here that one action leads to a large number 
of outcomes, namely, a sample of a pumped configuration results in many 
configurations, a path generated by a connection generator not only connects 
two configurations from different clusters but also a large number of con- 
figurations from those clusters, which arc not necessarily directly connected. 
Thus, these properties enable KPUMP to generate a variety of configurations 
and motions of the robots, using only few samples. To reproduce this variety 
by KBASIC one must generate far more samples. 

An additional advantage of the use of clusters lies in the fact that they can 
be connected more easily than two configurations, when a powerful compo- 
nent as the connection generator is at hand. Using this component KPUMP 
succeeds in solving difficult scenarios even in situations where the generated 
geometric graphs suffer from low connectivity, as in scenarios (c) and (d). 
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